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© ROBOT CAPABLE OF FORMING OPERATING PATH PATTERN. 



© A robot capable of automatically forming an operating path pattern based on taught data, and requiring only 
a simplified data teaching operation relating to the pattern formation and no specific teaching operation even 
when changing the pitch between pattern segments. If the starting point (P0) and the end point (Pn) of a thermal 
spray pattern consisting of consecutive subpatterns and the first inflection point (P1) of a first sub-pattern are 
taught to the robot in the manual operation of the robot, teaching data representing these three points are stored 
J? in the robot control device together with the thermal spray instruction code and the thermal spray pitch (d) 
taught separately. During the regenerative operation of the robot, a vector (A)that proceeds from the starting 
® point (PO) to the first inflection point (P1) and another vector (D) that proceeds from the first inflection point (P1) 
||j to a second inflection point (P2) are calculated in response to the thermal spray instruction code based on the 
taught data and the pitch, and each time when a plasma jet torch reaches the starting point, the first to third 
^ inflection points or the end point of a certain sub-pattern, a new desired moving position is determined at the 
^ end point of the vector (A), the vector (B) or what corresponds to an inversion vector of the vector (A) using said 
_ reaching point as a starting point to form the thermal spray pattern. 
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ROBOT CAPABLE OF GENERATING PATTERNS OF MOVEMENT PATH 



Technical Field 

The present invention relates to a robot which is capable of automatically generating patterns^ of 
movement path based on previously taught data, and more particularly, to a robot in which a data teaching 
operation for pattern generation is simplified, and no special data teaching is required even when the pitch 
between pattern segments is to be changed. 



Background Art 

Thermal spraying robots are conventionally known in which movement path patterns for a plasma jet 
torch consisting of a series of identical subpattems are generated based on taught data and the torch is 
moved in a plane in accordance with the generated patterns. 

In this type of robots, before spraying is carried out, an operator teaches the robot the start and end 
points of a first subpattem. individual cornering points between the start and end points, and a subpattern 
shift amount (consisting, for example, of the component of a shifting direction and the component of a 
direction perpendicular to the shifting direction). When taught the individual points, the robot stores, in a 
pattern file, joint angles (taught data) of individual robot axes for positioning the torch at the respective 
taught points. Also, when the subpattem shift amount is taught, it is stored in the file. 

In a spraying operation, the robot first carries out spraying on the first portion of a spraying plane in 
accordance with the first subpattern generated based on the taught data read from the pattern file. 
Subsequently, in accordance with the next subpattern generated by adding the shift amount to the 
individual points of the first subpattem, me robot effects spraying on a portion of the plane adjacent to the 
already sprayed portion. Thereafter, a similar operation is repeated in accordance with the subpattems 
successively generated, to complete a spraying operation over the entire spraying plane. 

In the conventional robot mentioned above, when the distance (pitch) between adjacent ones of pattern 
segments constituting a subpattern and extending perpendicularly to the direction of pattern shifting is to be 
varied, the start point, individual cornering points, and end point of the subpattern and the subpattem shift 
amount must be taught again. This requires much effort for the teaching. Particularly, when a high pattern 
generation accuracy is required, the teaching must be carefully carried out and thus a long time is required 
for the teaching. 



Disclosure of the Invention 

An object of the present invention is to provide a robot which is capable of automatically generating 
patterns of movement path based on previously taught data, in which a data teaching operation associated 
with pattern generation is simplified and no special data teaching is required even when the pitch between 
pattern segments is to be changed. 

To achieve the above object, the robot according to the present invention comprises teaching means for 
previously teaching a start point, an end point and one cornering point of a movement path pattern and a 
pitch between pattern segments, storing means for storing taught data respectively corresponding to the 
start point, end point, and one cornering point of the movement path pattern and the pitch thus taught, and 
pattern generating means for automatically generating a movement path pattern based on the taught data. 

As described above, according to the present invention, a movement path pattern is automatically 
generated based on the taught data corresponding to the start point, end point and one cornering point of 
the movement path pattern and the pitch between the pattern segments which are all previously taught 
Accordingly, only a simple teaching operation, namely, teaching the above three points of the movement 
path pattern and the pattern pitch, is needed before an actual operation of the robot. Moreover, when the 
pattern pitch is to be changed, a new pitch has only to be taught and it is unnecessary to teach the 
respective points of the pattern again. 



Brief Description of the Drawings 
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Fig. 1 is a schematic block diagram showing a principal part of a spraying robot according to one 
embodiment of th present invention; 

Fig. 2 is a schematic diagram showing a spraying pattern; 

Fig. 3A is a flowchart showing part of a spraying operation program executed by a robot control unit in 

5 Fig. 1; 

Fig. 3B is a flowchart showing the remaining part of the spraying operation program; and 

Fig. 4 is a vector diagram showing various vectors used in a spraying pattern generating process. 

w Best Mode of Carrying Out the Invention 

Referring to Fig. 1, a thermal spraying robot of an embodiment of the present invention comprises a 
robot control unit 10, a robot mechanism 30 including servomotors (not shown) for individual axes and 
sensors (not shown) for detecting rotational angles (joint angles) of the motors of the individual axes, and a 

75 plasma spraying apparatus 40 having a plasma jet torch 41, and is arranged to control the position and 
orientation of the torch by the servomotors for the individual axes driven by the control unit 10, so as to 
perform plasma spraying on a fiat surface of a workpiece (not shown) such as various component parts. 

Specifically, the control unit 10 comprises a central processing unit (CPU) 11, a read-only memory 
(ROM) 12 storing various control programs executed by the CPU 11, and a random-access memory (RAM) 

20 13. The control unit 10 further comprises a teaching pendant 14 having a numerical display unit, lamps, 
operating buttons, etc., a manual data input unit (CRT/MDI) 15 having a CRT display unit and various keys 
including character/number keys, cursor keys, function keys, etc., an axis controller 16 including an 
interpolator, and servo circuits 17 connected to the axis controller. Reference numeral 18 denotes an 
interface between the control unit 10 and the robot mechanism 30 and between the control unit 10 and the 

25 plasma spraying apparatus 40, and 20 denotes busses connecting the above-mentioned elements 12 to 16, 
18 and 19 to the CPU 11. 

The CPU 11 is arranged to read joint angles (taught data) of the individual axes of the robot mechanism 
30 each time an operator executes a registering operation with the plasma jet torch 41 positioned at each of 
teaching points in a required orientation while the robot is manually operated, by operating the teaching 

30 pendant 14 and/or the CRT/MDI 15. Further, the CPU 11 is operable to read various instruction codes and 
data which are input by the operator through the pendant 4 and/or the CRT/MDI 15. Moreover, a teaching 
program is prepared by the CPU 11 based on the taught data, instruction codes, etc., and the created 
program is stored in the RAM 13. The control unit 10 has a tape reader 19, and an operation program 
created by the operator on an off-line basis and input through the tape reader 19 is stored in the RAM 13. 

35 The operation of the robot in Fig. 1 will be now described with reference to Figs. 2 to 4. 

Prior to a playback operation of the robot the operator teaches the robot a movement path pattern 
(spraying pattern) of the torch on a plane of a workpiece, while manually operating the robot The spraying 
pattern, shown in Fig. 2 by way of example, consists of a series of subpattems, and is, as a whole, in the 
form of a comb. The subpattems are identical with each other and each consist of four pattern segments 

40 individually connecting adjacent ones of a start point, three cornering points, and an end point The last 
subpattern, however, consists of the first segment alone. In Fig. 2, symbols P0 and Pn denote the spraying 
start point and spraying end point respectively, and P0 to P4 respectively denote the start point, first to 
third cornering points, and end point of the first subpattern. Symbols P4 to P7 denote the start point and 
first to third cornering points of the second subpattern, respectively, and Pi generally represents the start 

45 point, cornering point or end point (in Fig. 2, cornering point) of a subpattern. Symbol d represents the 
spraying pitch, i.e., the distance between adjacent ones of (e.g., between the first segment P0P1 and third 
segment P2P3 of the first subpattern) parallel pattern segments extending horizontally in Fig. 2. 

More specifically, to teach the spraying pattern, the operator first positions the plasma jet torch 41 in a 
required orientation at the spraying start point P0 on the workpiece plane, while manually operating the 

so robot and teaches the robot the position and orientation of the torch assumed at that time. The CPU 11 
reads the joint angles (taught data) of the individual axes detected by the various sensors of the robot 
mechanism 30 and corresponding to the position and orientation of the torch at the point P0, and causes 
the data to be stored in the RAM 13. Subsequently, when the operator inputs a spraying command code, 
the CPU 11 causes the code to be stored in the RAM 13 in association with the spraying start point P0. 

55 Then, the operator teaches the position and orientation of the torch at the first cornering point P1 of the first 
subpattern, and the CPU 11 causes data, representing the joint angles of the individual axes corresponding 
to the torch position and orientation at the point P1, to be stored in the RAM 13. Next, when the operator 
inputs a value of the spraying pitch d , the same value is stored in the RAM 13. When the spraying end 
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point Pn is taught, the joint angles of the individual axes at that time are stored in the RAM 13. Finally, the 
operator inputs a number m of times by which the spraying operation for the same workpiece plane is to be 
repeated in accordance with the spraying pattern, and the CPU 11 causes this target repetitions m of 
spraying to be stored in the RAM 13. 

When necessary, an additional teaching operation is executed to input other various teaching data and 
various instruction codes. On the basis of the spraying pattern etc. taught in the above manner, the CPU 11 
creates a required teaching program and causes the same to be stored in the RAM 13. 

During a playback operation of the robot, the CPU 1 1 reads out the teaching program one data block by 
one data block from the RAM 13 and successively executes these data blocks, the aforesaid program 
including a program for effecting a spraying operation including a spraying pattern generating process (Fig. 
3). 

Specifically, in the playback operation of the robot, the CPU 1 1 reads out one data block of the teaching 
program (step S1 in Fig. 3), and determines whether or not this data block includes the spraying command 
code (step S2). If no spraying command code is included, a required operation (this operation does not 
relates to the present invention and hence an explanation thereof will be omitted) other than the spraying is 
carried out. 

If it is determined in step S2 that the spraying command code is included, the CPU 11 reads out the 
spraying pitch d and the target repetitions m of spraying from the RAM 13, and stores the same in 
corresponding rigisters accommodated in the CPU. The CPU 11 further reads out the joint angles of the 
individual axes corresponding to the torch position at the start of the spraying operation (spraying start 
position PO), from corresponding registers accommodated therein, and reads out two sets of joint angles of 
the individual axes corresponding respectively to the first cornering point P1 of the first subpattern and the 
spraying end point Pn. both previously taught, from the RAM 13. Then, the CPU successively converts 
these three sets of joint angles corresponding to the points PO. P1 and Pn into respective directional 
components along X, Y and Z axes of an orthogonal coordinate system by a coordinate conversion process, 
the results of the conversion being stored in corresponding registers (step S3). 

Next, the CPU 11 calculates first to third vectors A B and C, shown in Fig. 4, based on the X-, Y-, and 
Z-axis directional components of the three points PO, P1 and Pn, respectively, and causes the derived data 
to be stored in corresponding registers (step S4). The start and end points of the first vector A coincide with 
the points PO and P1, respectively, the start and end points of the second vector B coincide with the points 
P1 and Pn. respectively, and the start and end points of the third vector C coincide with the points P1 and 
Pn. respectively. In this specification, various vectors including the first to third vectors are denoted by bold- 
faced symbols. 

The CPU 11 then derives an outer product vector a of the first and third vectors A and C. an outer 
product vector b of the outer product vector a and the vector A, and an inner product f of the unit vector of 
the second vector B and the outer product vector b (steps S5-S7). The outer product vector a (not shown) 
represented by the following equation (1), which is a normal vector associated with the plane (workpiece 
surface) passing the three points PO. P1 and Pn, is perpendicular at the point PO in Fig. 4 to the drawing 
paper and directed from the rear side to the front side of the paper. The outer product vector b represented 
by the following equation (2) is parallel to the workpiece surface and perpendicular to the first vector A. The 
inner product f represented by the following (3) indicates the cosine of the angle between tine second vector 
8 and the outer product vector b. 



a = A x C 



b = a x A 



(1) 
(2) 



B 

f = 

IBI 



b 



(3) 



Ibl 



Next, on the basis of the spraying pitch d , the inner product f and the second vector B. the CPU 1 1 
derives a fourth vector (pitch vector) D represented by the following equation (4). and having start and end 
points respectively coinciding with the first and second cornering points PI and P2 of the first subpattern 
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(step S8). 

1 B " 
D = d x _ x (4) 

f IB! 

Then, after setting an index i to "0" In step S9. the CPU 11 updates the value of the index i to "1" 
(generally, to "i-M") (step S10). and divides the updated value of the Index I by 0 4", to obtain a remainder 
jo R (step S1 1). At the start of a spraying operation, the CPU 1 1 determines that the remainder R is "1 n (step 
SI 2), and adds the first vector A to the current torch position P0 to determine the target position P1 (step 
S13). Generally, in step S13. the first vector A is added to the current torch position (previous target 
position) Pi-1, thereby determining the target position Pi represented by the following equation (5). 

15 

Pi = Pi-1 + A ... (5) 



20 Then, to move the plasma jet torch 41 of the plasma spraying apparatus 40 from the current position 
Pi-1 (here, PO) to the target position Pi (here, P1), the CPU 11 distributes pulses to the servo circuits 17 of 
the individual axes through the axis controller 16 (step S17). Accordingly, the servomotors of the individual 
axes of the robot mechanism 30 are driven, and thus the torch is moved from the current position Pi-1 
toward the target position Pi. While the torch is moved, the CPU 11 drives the plasma spraying apparatus 

25 40 through the interface 18, whereby plasma spraying is performed on the surface portion of the workpiece 
from the point Pi-1 to the point Pi. Here, a plasma spraying along the first segment P0P1 of the first 
subpattem is effected. 

In the next step S18, the CPU 11 determines whether or not the remainder R is "1 Since the result of 
the determination in step S18 immediately after the start of spraying operation is affirmative (YES), the CPU 
30 11 calculates the magnitude of a fifth vector E (not shown) having a start point thereof at the point P1 and 
an end point thereof at the point Pi, based on the first cornering point P1 of the first subpattern and the 
target position Pi, and then determines whether the magnitude |E| of the fifth vector is equal to or smaller 
than the magnitude of the second vector B, namely, whether or not the spraying end point Pn has been 
reached (step S19). 

35 Immediately after the spraying is started, the target position Pi is identical with the first cornering point 
P1 (E = D), and thus the result of the determination in step S19 is negative (NO). Accordingly, the flow 
returns to the aforesaid step S10 and the value of the index I (= 1) is updated to "i + 1 (= 2) B . As a result, 
the remainder R obtained in step S11 is "2", and the result of the determination in step S12 becomes 
negative. The CPU 11 then determines in step S14 whether the remainder R is "0" or "2". Here, Since the 

40 result of the determination in step S14 is affirmative, the pitch vector 0 is added to the current torch 
position P1 (generally, Pi-1), to obtain the target position P2 (generally, Pi represented by the following 
equation (6)) (step S15). 

45 Pi = - D ... (6) 



Then, in the step S17, plasma spraying is performed from the point P1 to P2 along the second 
segment Since the result of the determination in the following step S18 is negative, the flow returns to step 
50 S10. 

In this case, the remainder R is "3", and the results of the determinations in steps S12 and S14 
following steps S10 and S1 1 are both negative, and hence, the target position P3 (generally, Pi represented 
by the following equation (7)) is obtained by subtracting the first vector A from the current torch position P2 
(generally, Pi-1) (step S16). 
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Pi = Pi-1 - A . ♦ . (7) 



Then, in the step S17, plasma spraying is effected from the point 92 to P3 along the third segment 
Since the result of the determination in the following step S18 is negative, the flow returns to step S10. 

in this case, the remainder R is "0", and the result of the determination in step S12 following steps S10 
and S11 is affirmative. Accordingly, the target position P4 is derived in the step S15, and piasma spraying 
is carried out from the point P3 to the point P4 along the fourth segment in step S17. In this way, first 
plasma spraying from the start point PO to end point P4 of the first subpattern is completed. 

In the following step S18, the result of the determination is negative, and thus the flow returns to step 
S10. Thus, a first plasma spraying along the first to fourth segments of the second subpattern Is carried out 

In a similar manner, first plasma spraying is performed successively on the respective subpatterns. 
When, in step S19 immediately after the completion of first plasma spraying along the first segment of the 
last subpattern, it is determined that the magnitude |E| of the fifth vector is equal to the magnitude |B| of the 
second vector, namely, the torch has reached the spraying end point Pn, the CPU 11 decrements the 
register value representing the target number of times the spraying operation, from n m" to "nVT (step 
S20). The CPU 11 then determines whether the new register value m (= m-1) is equal to or smaller than 
"0", namely, whether or not the plasma spraying along the spraying pattern has been carried out the target 
number of times m (step S21). If the result of the determination is negative, the CPU 11 carries out pulse 
distribution in step"S22, to move the plasma jet torch 41 from the spraying end point Pn to the spraying 
start point PO, and resets the index i to "0". Whereupon, the step S10 is entered. 

When the plasma spraying along the spraying pattern from the spraying start point PO to the spraying 
end point Pn is repeated the target number of times m , the result of determination at step 21 and 
immediately after that time becomes affirmative. In this case, the CPU 11 proceeds to a process (this 
process does not relate to the present invention, and hence an explanation thereof will be omitted) 
subsequent to the spraying process of Fig. 3. 

The present invention is not limited to the above-described embodiment alone, and various modifica- 
tions thereof may be made. 

For example, although in the above embodiment, the invention is applied to a thermal spraying robot, it 
can be applied to various types of robots which are designed to work in a plane along a movement path 
pattern composed of a combination of segments extending in a first direction and segments extending in a 
second direction. 

Further, in the foregoing embodiment, the teaching data (the spraying start point PO, the cornering point 
P1, the spraying end point Pn, and the spraying pitch d ) is taught during a manual operation of the robot. 
Alternatively, the teaching data may be stated, by using programming language, in a program which is 
prepared offline. 



Claims 

1. A robot comprising: 

teaching means for previously teaching a start point, an end point and one cornering point of a 
movement path pattern and a pitch between pattern segments; 

storing means for storing taught data respectively corresponding to the start point, end point, and 
one cornering point of the movement path pattern and the pitch thus taught; and 

pattern generating means for automatically generating the movement path pattern on the basis of 
the taught data. 

2. A robot according to claim 1, wherein said teaching means is operable to input a numerical value of the 
pitch between the pattern segments. 

3. A robot according to claim 1 , wherein said robot has a tool driven along the movement path pattern; 

wherein the movement path pattern is composed of a series of identical subpatterns, each of the 
subpatterns including a first segment connecting a start point thereof and a first cornering point, a 
second segment connecting the first cornering point and a second cornering point, a third segment 
extending parallel to th first segment and connecting the second cornering point and a third cornering 
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point, and a fourth segment extending parallel to the second segment and connecting the third 
cornering point and an end point and 

wherein said pattern generating means is operable to calculate first and second vectors cor- 
responding respectively to the first and second segments on the basis of the taught data stored in said 
5 storing means, and is operable to determine a new target position by using a corresponding one of the 
first and second vectors when the tool reaches a target position corresponding to one of the start point 
and the first to third cornering points of a certain one of the subpattems, 

4. A robot according to claim 3, wherein said pattern generating means is operable to determine the end 
10 point as a new target position, of the first vector having a start point thereof coinciding with a target 

position which corresponds to one of the start and end points of a certain one of the subpattems when 
the tool reaches the target position ; 

wherein said pattern generating means is operable to determine the end point, as a new target 
position, of the second vector having a start point thereof coinciding with a target position which 
is corresponds to one of the first and third cornering points of the subpattem when the tool reaches the 
target position; and 

wherein said pattern generating means is operable to determine the end point as a new target 
position, of a vector derived by reversing the first vector and having a start point thereof coinciding with 
a target position which corresponds to the second cornering point of the subpattem when the tool 
20 reaches the target position. 

5. A robot according to claim 4, wherein said pattern generating means is operable to calculate, on the 
basis of the taught data stored in said storing means, a first fundamental vector having a start point 
thereof coinciding with the start point of the movement path pattern and an end point thereof coinciding 

25 with the first cornering point of a first subpattem of the movement path pattern, a second fundamental 
vector having a start point thereof coinciding with the first cornering point of the first subpattem and an 
end point thereof coinciding with the end point of the movement path pattern, and a third fundamental 
vector having a start point thereof coinciding with the start point of the movement path pattern and an 
end point thereof coinciding with the end point of the movement path pattern; and 

30 wherein said pattern operating means is operable to calculate a first unit vector whose direction is 

the same as that of an outer product vector of the first fundamental vector and an outer vector of the 
first fundamental vector and the third fundamental vector, and a second unit vector whose direction is 
the same as that of the second fundamental vector; and 

wherein said pattern generating means is operable to calculate the second vector corresponding to 

35 the second segment, by multiplication of a reciprocal of an inner product of the first and second unit 
vectors, the pitch between the pattern segments, and the second unit vector. 

8. A robot according to any one of claims 1 to 5, wherein said robot comprises a thermal spraying robot 
having a plasma jet torch. 

40 
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FIG.3A 
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FIG.3B 
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CLAIMS 
1. A robot comprising: 

teaching means for previously teaching a start 
point, an end point and one cornering point of a 
movement path pattern and a pitch between pattern 
segments; 

storing means for storing taught data respectively 
corresponding" to the start point, end point, and one 
cornering point of the movement path pattern and the 
pitch thus taught; and 

pattern. generating means for automatically 
generating the movement path pattern on the basis of 
the taught data. 

2. A robot according to claim 1, wherein said 
teaching means is operable to input a numerical value 
of the pitch between the pattern segments. 

' 37" A robot" according to claim 1. wherein said 
robot has a tool driven along the movement path 
pattern ; 

wherein the movement path pattern is composed of 
a series of identical subpatterns, each of the 
subpatterns including a first segment connecting a 
start point thereof and a first cornering point, a 
second segment connecting the first cornering point and 
a second cornering point, a third segment extending 
parallel to the first segment and connecting the second 
cornering point and a third cornering point, and a 
fourth segment extending parallel to the second segment 
and connecting the third cornering point and an end 
point; and 

wherein said pattern generating means is operable 
to calculate first and second vectors corresponding 
respectively to the first and second segments on the 
basis of the taught data stored in said storing means. 
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and Is operable to determine a new target position by 
using a corresponding* one of the first and second 
vectors when the tool reaches a target position 
corresponding to one of the start point and the first 
to third cornering points of a certain one of the 
subpatterns. 

4. A robot according to claim 3, wherein said 
pattern generating means is operable to determine the 
end point, as a new target position, of the first 
vector having a start point thereof coinciding with a 
target position which corresponds to one of the start 
and end points of a certain one of the subpatterns when 
the tool reaches the target position ; 

wherein said pattern generating means is operable 
to determine the end point, as a new target position, 
of the second vector having a start point thereof 
coinciding with a target position which corresponds to 
one of the first and third cornering points of the 
subpattern when the tool reaches the target position; 
and 

wherein said pattern generating means is operable 
to determine the end point, as a new target position, 
of a vector derived by reversing the first vector and 
having a start point thereof coinciding with a target 
position which corresponds to the second cornering 
point of the subpattern when the tool reaches the 
target position. 

5. A robot according to claim 4, wherein said 
pattern generating means is operable to calculate, on 
the basis of the taught data stored in said storing 
means, a first fundamental vector having a start point 
thereof coinciding with the start point of the movement 
path pattern and an end point thereof coinciding with 
the first cornering point of a first subpattern of 
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the movement path pattern, a second fundamental vector 
having a start point thereof coinciding with the first 
cornering point of the first subpattern and an end 
point thereof coinciding with the end point of the 
movement path pattern, and a third fundamental vector 
having a start point thereof coinciding with the start 
point of the movement path pattern and an end point 
thereof coinciding with the end point of the movement 
path pattern; and 

wherein said pattern operating means is operable 
to calculate a first unit vector whose direction is the 
same as that of an outer product vector of the first 
fundamental vector and an outer vector of the first 
fundamental vector and the third fundamental vector, 
and a second unit vector whose direction is the same as 
that of the second fundamental vector; and 

wherein said pattern generating means is operable 
to calculate the second vector corresponding to the 
second segment, by multiplication of a reciprocal of an 
inner product of the first and second unit vectors, the 
pitch between the pattern segments, and the second unit 
vector. 

6. A robot according to any one of claims 1 to 5. 
wherein said robot comprises a thermal spraying robot 
having a plasma jet torch. 



